# -*- coding: utf-8 -*-
#手臂模块

import time
import restoration.claw as claw
import restoration.cube as cube
import restoration.command as command

ARM_REVERSAL=1;
ARM_FORWARD=0;

#1号手臂转动
def ARM_1_Turn(dir,angle):
    #通知stm32开始输出脉冲
    command.turnArm(1,"f" if dir==ARM_FORWARD else "r",angle);

#2号手臂转动
def ARM_2_Turn(dir,angle):
    #开始输出脉冲
    command.turnArm(2,"f" if dir==ARM_FORWARD else "r",angle);

def toZeroLoc():
    command.toZeroLoc();

